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INTRODUCTION 


PURPOSE. 

The  purpose  of  these  tests  was  to  investigate  the  feasibility  and  accuracy  of 
deriving  groundspeed  information  from  terminal  distance  measuring  equipment 
(DME). 

BACKGROUND. 


The  potential  hazards  of  terminal  area  wind  shear  have  been  brought  to  the 
attention  of  the  aviation  community  by  several  recent  accidents.  The  Federal 
Aviation  Administration  (FAA)  has  responded  by  instituting  an  intensive  pro- 
gram which  encompasses  all  facets  of  the  wind  shear  problem.  This  program  is 
examining  methods  of  detecting  wind  shear  and  alerting  the  aviation  community 
to  its  presence.  The  detection  program  Involves  various  meteorological  fore- 
casting techniques,  ground  detection,  and  airborne  detection  systems.  This 
document  focuses  on  one  proposed  method  for  developing  an  airborne  wind  shear 
detection  system.  Simulator  studies  and  practical  experience  have  shown  that 
a comparison  between  groundspeed  and  airspeed  can  be  effectively  utilized  to 
detect  and  counter  wind  shear.  The  problem  is  to  determine  groundspeed  cheaply, 
accurately,  and  with  little  time  lag.  This  report  focuses  on  this  problem. 

DESCRIPTION  OF  EQUIPMENT. 

All  of  the  tests  described  in  this  report  were  done  with  DME  Interrogators 
conforming  to  Aeronautical  Radio  Incorporated  (ARINC)  specification  568.  The 
two  Interrogators  used  were  a Collins  Radio  860E-3  and  a King  Radio  KDM-7000. 

The  ARINC  568  characteristic  for  the  range  rate  output  on  these  units  is  one 
pulse  every  time  the  aircraft  distance  changes  by  0.01  nautical  mile  (nml). 


LABORATORY  TEST  PHASE 


DISCUSSION. 

Laboratory  tests  were  accomplished  on  both  interrogators  to  Investigate  their 
range  rate  accuracy  and  their  response  time  to  changes  in  velocity.  A block 
diagram  of  the  test  setup  is  shown  In  figure  1.  The  DME  under  test  was  con- 
nected to  a Squak/Naut  1 DME  test  set.  This  unit  produces  DME  interrogation 
replies  with  various  time  delays  to  simulate  aircraft  distance  to  the  DME 
ground  transmitter.  The  test  set  can  Increment  or  decrement  distance  to 
simulate  velocity  and  can  Increment  or  decrement  velocity  to  simulate  acceler- 
ation or  deceleration. 

The  range  rate  ouput  pulse  spacing  was  measured  by  a frequency  counter  and 
printed  on  a digital  printer.  The  measurement-print  cycle  was  synchronized 
to  a 1-hertz  (Hz)  rate  by  a time  code  generator.  A Hewlett-Packard  9830A 
calculator  was  programmed  to  convert  the  pulse  spacing  measurements  to  velocity 
data  and  graph  the  results. 
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Tr ST  PROCEDURES. 

ioui:  merles  of  tests  were  conducted.  In  the  first,  the  velocity  was  smoothly 
incremented  or  decremented  by  5 knots  at  a 1 foot  per  second  squared  (ft/s^) 
rate.  In  the  second  series,  the  velocity  was  changed  by  15  ki.ots,  at  1 ft/s^. 

In  the  third  series,  the  velocity  was  changed  instantaneously  by  5 knots.  In 
the  fourth  series,  the  velocity  was  changed  Instantaneously  by  15  knots.  In 
all  t 'sts  the  interrogators  were  allowed  to  lock  on  and  stabilize  at  constant 
velocity  for  approximately  5 minutes  before  any  variations  were  introduced. 

The  King  KDM-7000  was  operated  in  both  a high  pulse  repetition  frequency  (PRF) 
mode  of  72  pulses  per  second  (pps)  and  its  normal  PRF  of  12  pps.  A minor 
Intorr al  modification  consisting  of  one  jumper  was  necessary  to  allow  the  King 
KDM-7000  interrogator  to  operate  in  the  higher  PRF  mode.  The  Collins  860E-3 
did  not  have  the  high  PRF  capability  and  therefore  was  operated  only  in  its 
normal  PRF  mode  which  was  18  pps. 

TEST  RESULTS. 

The  range  rate  output  of  the  Collins  860E-3  is  reasonably  stable  and  accurate 
but  slow  to  respond  to  changes  in  velocity.  Figures  2 and  3 illustrate  range 
rate  responses  for  velocity  changes  of  -5  and  -15  knots.  The  velocity  change 
from  the  test  set  to  the  interrogator  was  accomplished  at  a rate  of  1 ft/s^. 

The  interrogators  were  also  subjected  to  step  inputs  from  the  test  set. 

Figures  4 and  5 illustrate  the  response  of  the  860E-3  range  rate  output  to 
step  inputs  of  -5  and  -15,  respectively.  The  interrogator  was  also  subjected 
to  increasing  velocity  rates  and  step  changes.  The  results  were  similar  to 
those  shown  for  the  decreasing  rates  and  step  changes. 

Similar  tests  were  conducted  on  the  King  KDM-7000  interrogator,  but  it  quickly 
became  evident  that  the  range  rate  output  was  extremely  noisy.  Figure  6 
illustrates  the  range  rate  output  for  a constant  velocity  of  120  knots.  In 
order  to  produce  a dlscernable  plot,  a smoothing  calculation  was  performed  by 
taking  an  equal-weighted  average  of  10  preceding  points  (including  the  data 
point  in  question)  and  then  plotting  this  value.  This  technique  was  used  to 
produce  the  plot  of  figure  7 which  represents  the  filtered  output  of  the  King 
interrogator  subjected  to  a velocity  change  of  -15  knots.  Statistics  were  run 
on  the  error  between  the  range  rate  outputs  of  both  interrogators  and  a constant 
velocity  input  from  the  test  set.  The  error  was  determined  from  the  equation: 
Error  = Measured  Groundspeed  - Input  Reference  Groundspeed.  The  statistics 
are  presented  in  table  1. 


TABLE  1.  STATISTICAL  ERROR  TABULATION  OF  CONSTANT  VELOCITY  LABORATORY  TEST 
RESULTS  FOR  COLLINS  AND  KING  INTERROGATORS 


Number  of 

Mean  Error 

Standard  Deviation 

Interrogator 

Samples 

(knots) 

(knots) 

860E-3 

100 

-1.25 

1.15 

KDM-7000 

100 

1.54 

19.30 
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Statistics  were  also  generated  for  the  King  KDM-7000  for  the  two  different 
PRF's  at  which  It  was  capable  of  operating.  These  statistics  are  presented  In 
table  2.  The  samples  were  taken  at  a constant  velocity  of  120  knots. 


TABLE  2.  STATISTICAL  ERROR  TABULATION  OF  CONSTANT  VELOCITY  LABORATORY 
TEST  RESULTS  FOR  KING  INTERROGATOR  AT  LOW  AND  HIGH  PRF's 


PRT  (PPs) 


Number  of  Standard  Deviation 

Samples  (knots) 


12  50  17.5 

72  50  20.1 


PRELIMINARY  FLIGHT  TEST  PHASE 


DISCUSSION. 


The  test  setup  used  In  the  aircraft,  a Grumman  Gulf stream  I,  was  Identical  to 
the  setup  used  In  the  laboratory,  with  the  exception  that  the  DME  test  set  was 
not  required.  All  data  runs  were  approaches  to  the  National  Aviation  Facilities 
Experimental  Center  (NAFEC)  runway  13,  using  the  commissioned  instrument  land- 
ing system  (ILS)  and  terminal  DME. 

The  terminal  ME  used  In  these  tests  was  a Butler  National  Corporation 
Model  1020.  This  Is  a low-powered  (90  watt  (W)  nominal)  DME  designed  for 
terminal  use.  This  equipment  had  been  previously  evaluated  at  NAFEC  on  other 
programs.  Reports  Issued  on  It  Include,  "Test  and  Evaluation  of  Engineering 
Models  of  Terminal  Area  DME,"  FAA-RD-71-108,  by  George  J.  Hartranft  and 
"Evaluation  of  Techniques  Used  in  the  Butler  Terminal  Area  Model  1020  Distance 
Measuring  Equipment,"  FAA-RD-74-208,  by  Robert  H.  Erlkson. 

The  first  series  of  approaches  were  tracked  by  the  NAFEC  photo-optical  theodo- 
lite system,  while  the  second  series  of  approaches  were  tracked  by  the  Extended 
Area  Instrumentation  Radar  (EAIR) . The  data  from  these  tracking  facilities 
provided  the  groundspeed  reference  against  which  the  DME-derlved  groundspeed 
was  compared . 

TEST  PROCEDURES. 

The  first  series  of  approaches  focused  on  the  time  delays  Involved  In  sensing 
a change  of  velocity  due  to  aircraft  acceleration  or  deceleration.  On  the 
approach,  the  aircraft  stabilized  at  constant  airspeed  for  at  least  2 minutes, 
then  accelerated  or  decelerated  from  125  to  140  knots  true  airspeed  (TAS)  or 
vice  versa.  This  final  speed  was  held  until  threshold,  approximately  2 more 
minutes.  Eight  runs  were  flown  this  way,  four  recording  the  output  of  the 
KDM-7000  Interrogator,  and  four  recording  the  output  of  the  860E-3  Interrogator. 


The  KDM-7000  was  operated  In  the  ILS  mode  with  an  interrogation  rate  of  72  pps. 
The  860E-3  does  not  have  a hlgh-PRF  mode  and  was  operated  at  the  normal  PRF  of 
18  pps.  The  second  series  of  approaches  were  flown  at  as  constant  an  airspeed 
as  could  be  maintained  during  the  approach. 

TEST  RESULTS. 

Figures  8 and  9 show  typical  results  from  the  two  Interrogators  on  acceleration/ 
deceleration  runs.  Collins  860E-3  range  rate  outputs  are  typified  by  figure  8, 
which  represents  an  acceleration  of  about  15  knots.  Phototheodolite  tracking 
provides  the  groundspeed  reference.  The  time  lag  In  the  response  of  the  860E-3 
Is  evident.  No  statistical  calculations  were  made,  because  the  standard  devia- 
tion of  the  tracking  data  was  higher  than  that  of  the  DME  range  rate  data. 

The  range  rate  outputs  of  the  King  KDM-7000  are  typified  by  figure  9,  which 
represents  a deceleration  of  about  15  to  20  knots.  EAIR  tracking  provides  the 
groundspeed  reference.  The  noisy  response  is  evident.  The  flight  test  data 
on  the  King  Interrogator  agrees  closely  with  laboratory  test  data.  Typical 
test  data  resulted  In  a mean  error  of  -4.0  knots  and  a standard  deviation  of 
19.2  knots  for  102  samples. 

SUMMARY  OF  LABORATORY  AND  PRELIMINARY  FLIGHT  TEST  RESULTS. 

The  results  of  the  preliminary  flight  tests  as  well  as  the  laboratory  tests  are 
summarized  In  table  3.  This  data  summary  makes  It  obvious  that  the  range  rate 
outputs  of  these  two  Interrogators  are  not  usable  In  their  present  form  to 
provide  groundspeed  Input  to  a wind  shear  detection  algorithm.  Further  pro- 
cessing of  the  range  rate  outputs  of  either  DME  is  required  to  produce  usable 
groundspeed . 


TABLE  3.  SUMMARY  OF  LABORATORY  AND  PRELIMINARY  FLIGHT  TEST  RESULTS  FOR 
COLLINS  AND  KING  INTERROGATORS 


Range  Rate  Delay 

Constant  Velocity 
Mean  Error 

Constant  Velocity 
Standard  Deviation 

Usability 


Collins  860E-3 
30-45  second  delay 
within  1.5  knots 


+1.2  knots 

Range  rate  output 
not  responsive  enough 
for  wind  shear 
determination  In 
present  form. 


King  KDM-700Q 
very  little  delay 
within  2.0  knots 


+20.0  knots 

Range  rate  output 
too  noisy  for  wind 
shear  determination 
in  present  form. 
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SUBSEQUENT  FLIGHT  TEST  PHASE 


DISCUSSION. 

The  results  of  the  laboratory  tests  and  the  preliminary  flight  tests  indicated 
that  some  sort  of  signal  processing  would  be  necessary  in  order  to  obtain 
usable,  responsive,  groundspeed  Information  from  either  DME.  Subsequently, 
work  proceeded  on  determining  what  type  of  signal  processing  was  necessary  to 
provide  usable  groundspeed.  This  work  was  done  as  both  a contractual  and  in- 
house  effort. 

Rockwell  International,  Collins  Radio  Group,  performed  some  simulation  work 
under  modification  two  of  contract  DOT-FA75NA-2134 . This  work  was  done  by 
Mr.  James  A.  Klein  of  Collins  Radio  with  assistance  from  Mr.  David  Lawrence  of 
NAFEC.  The  simulation  and  study  effort  concentrated  on  Che  differential 
between  airspeed  and  groundspeed  as  a means  to  detect  wind  shear. 

Since  wind  shear  is  a very  rapidly  changing  phenomenon,  considerable  time  was 
spent  during  the  Collins  study  to  evaluate  the  amount  of  sensor  lag  on  ground- 
speed  that  could  be  tolerated  In  the  wind  shear  detection  program.  It  was 
determined  that  groundspeed  sensor  lags  on  the  order  of  3 to  5 seconds  yield 
promising  results  in  shear  detection  algorithms.  Accordingly,  Collins  developed 
two  methods  for  deriving  groundspeed  from  a 30-second-lagged  DME  range  rate 
output  (the  30-8econd-lagged  DME  range  rate  output  Is  typical  for  the  Collins 
860E-3  Interrogator) • 

The  first  method  employed  a lead/lag  compensator  to  reduce  the  lag  In  DME 
range  rate.  The  second  method  consisted  of  complementary  lagged  DME  range 
rate  with  filtered,  pitch-compensated,  longitudinal  acceleration  to  reduce  the 
lag.  Both  of  these  methods  were  designed  specifically  for  the  860E-3  Inter- 
rogator. 

In  addition  to  these  contractor-designed  filters,  other  filter  designs  were 
developed  In-house  for  both  the  Collins  and  King  interrogators.  The  filter 
techniques  considered  Included  (1)  simple  low  pass,  (2)  rate  limiters  plus 
low  pass,  (3)  low  pass  plus  lead/lag,  (4)  low  pass  plus  accelerometer  comple- 
mentation, and  (5)  Kalman  and  higher  order  complementation.  Initial  findings 
showed  several  of  these  to  be  totally  Impractical.  Therefore,  only  the  low 
pass  plus  lead/lag,  the  low  pass  plus  accelerometer  complementation,  and  the 
Kalman  techniques  were  fully  developed. 

All  flight  tests  of  these  filter  algorithms  were  conducted  in  an  FAA  test  bed 
aircraft,  a Convalr  880.  This  aircraft  Is  equipped  with  a Digital  Equipment 
Corporation  PDF  11/05  general  purpose  digital  computer  (figure  10).  All  filter 
algorithms  were  coded  In  BASIC  software  and  were  Implemented  in  the  digital 
domain  on  the  FDP-11/05.  The  filter  algorithms  were  transformed  from  the 
analog  domain  to  the  discrete-time  (digital)  domain  by  means  of  a bilinear 
Z transformation. 
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Where: 


Wb  “ 2 

T 


Tan  WaT 


T = Sampling  Interval 

Wd  = Prewarped  Digital  Frequency  (radians/second) 

Wa  = Analog  Frequency  (radians/second) 

This  provided  linear  recursive  difference  equations  which  were  easily  Imple- 
mented In  software.  The  accuracy  can  be  Improved  by  Increasing  the  sampling 
rate,  the  error  being  dependent  on  Iterations  performed  as  well  as  biasing 
of  the  analog  frequency  spectrum.  Hardware  considerations,  recording  cap- 
ability, and  simulation  expectations,  as  well  as  accuracy  requirements,  dictated 
the  10-Hz  sampling  rate. 

In  addition  to  the  general  purpose  digital  computer,  the  aircraft  was  equipped 
with  an  aircraft  systems  coupler  and  patch  panel  and  a NAFEC-deslgned  and 
fabricated  DME  data  interface.  The  aircraft  systems  coupler  and  patch  panel 
allows  various  aircraft  signals  to  be  selected  and  applied  to  digital  conversion 
circuitry  with  discrete  UNIBUS®  addresses  (UNIBUS  is  a registered  trademark 
of  Digital  Equipment  Corporation)  . This  allows  the  data  to  be  addressed  by 
the  PDF  11/05  and  used  in  the  computational  process . Accelerometer  and  verti- 
cal gyro  information  were  input  to  the  PDF  11/05  in  this  way. 

The  DME  data  Interface  (see  block  diagram  figure  11)  allowed  the  DME  pulse- 
spacing data  to  be  input  on  discrete  addresses  to  the  PDF  11/05  via  the 
UNIBUS.  The  Interface  therefore  provided  all  the  necessary  raw  data  to  the 
PDF  11/05  UNIBUS. 

Four  UNIBUS  addresses  were  also  output  to  a digital  data  recording  system. 

This  allowed  the  inputs  to  and  the  outputs  from  the  filter  algorithm  to  be 
recorded . Other  aircraft  parameter  data  including  inertial  navigation  sensor 
outputs  were  also  recorded.  The  groundspeed  output  of  the  Inertial  Navigation 
System,  a Litton  Industries  LTN-51,  provided  the  measurement  reference  for  all 
of  the  tests  in  the  Convair  880. 

By  using  a ground-based  PDP  11/15  general  purpose  computer  and  the  digital 
data  tape  recorded  on  the  test  flight,  the  test  approaches  could  be  rerun  on 
the  ground  and  the  filter  algorithms  modified  or  changed  to  improve  performance. 
This  reduced  the  number  of  flight  hours  necessary  to  an  absolute  minimum. 

After  the  algorithms  were  optimized  on  the  ground-based,  general  purpose  com- 
puter system,  they  were  again  flown  in  the  Convair  880  to  verify  performance. 
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TEST  PROCEDURES. 

The  filter  algorithms,  coded  In  BASIC,  were  loaded  Into  the  aircraft  PDF  11/05 
computer  utilizing  a high-speed  paper  tape  reader.  This  procedure  was  repeated 
each  time  a different  algorithm  was  to  be  evaluated.  The  computer  was  then 
placed  In  a run  status  as  the  aircraft  turned  on  final  approach.  The  aircraft 
was  stabilized  on  final  approach  course  approximately  4 nml  outside  the 
outer  marker. 

Aircraft  velocity  was  varied  rapidly  about  the  reference  approach  speed 
(approximately  135  knots)  on  some  runs,  while  on  other  runs  the  changes  In 
velocity  were  made  slowly.  Long-term  accuracy  and  stability  of  the  derived 
groundspeeds  were  also  checked  with  constant  speed  approach  runs. 

TEST  RESULTS. 

LEAD/LAG  FILTER.  The  contractor-designed  algorithm  was  Implemented  In  BASIC 
software  and  was  tried  using  the  range  rate  outputs  of  the  Collins  860E-3. 

The  algorithm  was  designed  to  reduce  the  Inherent  30-second  lag  In  the  range 
rate  output  of  this  Interrogator.  The  filter  Is  described  In  block  diagram 
form  In  figure  12. 

Raw  IKIE  range  rate  data  are  plotted  along  with  the  reference  Inertial  Naviga- 
tion System  (INS)  groundspeed  In  figure  13.  In  this  run,  aircraft  speed  was 
slowly  varied  about  a reference  speed.  The  effects  of  the  Internal  filtering 
of  the  860E-3  can  be  seen  In  the  lack  of  responsiveness  of  the  DME  range  rate 
output  to  the  changes  In  groundspeed. 

\ Figure  14  Is  a plot  of  the  output  of  the  lead/lag  filter  along  with  the  refer- 

ence INS  groundspeed  for  an  860E-3  data  run  with  slowly  varying  groundspeed.  As 
can  be  seen,  the  output  of  the  lead/lag  filter  Is  extremely  noisy.  This  out- 
put was  typical  for  other  data  runs  with  lead/lag  compensation.  Ex^unlnatlon 
of  the  data  shown  In  figure  15  can  explain  the  problem.  The  two  colximns  of 
figures  are  the  raw  range  rate  output  from  the  Interface  unit  and  the  output 
from  the  lead/lag  filter.  The  data  rate  Is  10  Hz.  The  arrows  on  figure  15 
Indicate  where  the  raw  range  rate  (Input  to  the  lead/lag  filter)  changes. 

In  some  cases,  the  change  approaches  1 ft/s  In  magnitude.  Since  the  lead/lag  ^ 

filter  has  an  Initial  gain  of  30,  a l-ft/s  change  on  the  Input  to  the  filter  \ 

Is  seen  as  a 30-ft/s  change  on  the  output,  thus  causing  the  noise  spikes  seen 
In  figure  14. 

The  problem  could  be  minimized  by  Increasing  the  range  rate  resolution  of  the 
i DME  and  Increasing  the  digital  filter  sampling  frequency  so  that  the  Input  to  I 

the  filter  more  closely  approximates  a continuous  function.  ■ 

Another  solution  to  the  problem  was  attempted  by  placing  a digital  low-pass 
filter  on  the  range  rate  output  of  the  Interface  unit  to  filter  the  data  before 
processing  In  the  digital  lead/lag  filter.  This  has  the  effect  of  approximating 
a continuous  function  input  to  the  lead/lag  filter.  One  negative  effect  of 
this  Is  the  introduction  of  a time  lag  on  the  filter  output.  Figure  16  shows 
the  results  of  a S-second  low-pass  prefilter  plus  the  lead/lag  filtration. 
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The  data  are  again  plotted  with  INS  reference  groundspeed  and  are  the  same  data 
used  for  figure  15.  The  effects  of  the  5-second  lag  can  be  seen. 

Low-pass  prefllter  time  constants  of  from  2 to  10  seconds  were  tried  on  the 
data  with  5 seconds  providing  the  optimum  statistical  results.  A statistical 
error  summary  of  the  three  runs  for  the  raw,  lead/lag,  and  prefiltered  lead/lag 
DME  range  rate  data  Is  presented  In  table  4.  The  error  Is  calculated  from  the 
formula:  Error  » Measured  Groundspeed  - INS  Reference  Groundspeed. 


TABLE  4.  STATISTICAL  ERROR  SUMMARY  OF  RESULTS  FOR  LEAD/LAG  FILTER  COMPENSATION 
ON  COLLINS  INTERROGATOR 


STABLE  GROUNDSPEED 


Number  of 

Mean 

Error 

Standard 

Deviation 

Samples 

(ft/s) 

(knots) 

(ft/s) 

(knots) 

Raw 

1,544 

2.3 

1.4 

6.9 

4.1 

Lead/lag 

5-second 

1,544 

4.5 

2.7 

28.7 

17.0 

Prefilter  plus 
lead/lag 

1,547 

0.5 

0.3 

7.6 

4.5 

SLOWLY  VARYING  GROUNDSPEED 

Number  of 

Mean 

Error 

Standard 

Deviation 

Samples 

(ft/s)  . 

(knots) 

(ft/s) 

(knots) 

Raw 

1,500 

6.1 

3.6 

10.0 

5.9 

Lead/lag 

5-second 

Prefilter 

plus 

1,499 

5.9 

3.5 

23.2 

13.7 

lead/lag 

1,500 

4.8 

2.8 

8.4 

5.0 

RAPIDLY  VARYING  GROUNDSPEED 

Number  of 

Mean 

Error 

Standard 

Deviation 

Samples 

(ft/s)  . 

(knots) 

Ift/sJ, 

(knots) 

Raw 

1,499 

3.6 

2.1 

15.8 

9.4 

Lead /lag 
5-second 

1,496 

8.4 

5.0 

28.5 

16.9 

Prefilter 

lead/lag 

plus 

1,499 

3.2 

1.9 

11.5 

6.8 

ACCELEROMETER  CCTIPLEMENTATION . The  technique  for  accelerometer  complementa- 


tion as  proposed  by  the  contractor  to  reduce  the  lag  In  DME  range  rate  Is  shown 
In  block  diagram  form  In  figure  17 . This  technique  calls  for  filtering  pitch- 
compensated  longitudinal  acceleration  with  a 30-second  low-pass  filter  which 
has  a gain  of  30.  This  acceleration  term  Is  added  to  the  30-second-lagged  DME 
range  to  produce  responsive  groundspeed. 


The  accelerometer  complementation  algorithm  was  Implemented  In  the  digital 
domain  for  operation  In  the  airborne  environment  on  the  Convalr  880  and  on  the 
ground  using  flight  test  data.  Initial  tests  yield  results  which  were  promising 
but  In  need  of  refinement.  Figures  18,  19,  £md  20  Illustrate  the  results  of 
the  Initial  attempts  at  acceleration  complementation.  The  data  runs  used  are 
for  stable,  slowly  varying,  and  rapidly  varying  groundspeeds,  respectively. 

The  slowly  varying  data  run  Is  the  same  as  was  used  for  the  lead/lag  filter 
Illustration. 

As  can  be  seen  In  figures  18,  19,  and  20,  the  accelerometer-complemented 
groundspeed  Is  responsive  and  closely  follows  the  INS  groundspeed,  but  Is 
biased  above  the  INS  groundspeed.  This  Is  caused  by  the  fact  that  the  comple- 
mentation filter  exhibits  a direct  current  (d.c.)  gain  of  30,  so  that  any  off- 
set In  the  acceleration  term  will  be  amplified  by  this  amount.  In  order  to 
eliminate  this  bias  effect.  It  Is  necessary  to  high-pass  the  acceleration  term 
to  wash  out  any  d.c.  component.  Several  factors  must  be  taken  Into  account  In 
choosing  the  correct  time  constant  for  the  high-pass  filter.  Considering  time 
domain  requirements,  the  filter  should  wash  out  in  a reasonably  short  period 
of  time.  Frequency  domain  considerations  require  that  the  pole  of  the  high- 
pass  filter  should  be  at  least  an  octave  below  the  pole  of  the  complementary 
low-pass  filter.  These  requirements  are  contradictory  In  nature. 

Lowering  the  time  constant  of  the  high-pass  filter  moves  Its  pole  closer  to  the 
pole  of  the  complementary  filter.  This  will  affect  the  overall  gain  and 
frequency  content  of  the  complementary  acceleration  to  the  extent  that  the 
derived  groundspeed  will  not  be  able  to  track  changes  due  to  a sustained  level 
of  acceleration.  The  high-pass  filter  time  constant  should  be  a compromise 
value  necessary  to  quickly  wash  out  bias  errors,  and  still  pass  short-term 
constant  accelerations. 

Tests  showed  that  a 60-second  filter  did  not  hamper  the  responsiveness  of  this 
technique.  However,  the  washout  time  was  unsatisfactory,  and  for  this  reason 
a time-varying  filter  was  employed.  This  was  simple  to  implement  as  a soft- 
ware digital  filtering  algorithm. 

The  time  constant  was  initialized  at  1 second  and  Incremented  by  0.1  seconds 
per  sample  period  until  a value  of  60  seconds  was  reached.  This  provided  rapid 
Initial  washout  of  d.c.  acceleration  components  as  well  as  allowing  the  cap- 
ability to  track  groundspeed  during  short  term  constant  acceleration.  Figures 
21,  22,  and  23  show  the  results  obtained  by  prefiltering  the  acceleration  com- 
ponents with  a time-varying  high-pass  filter.  The  DME-derived  groundspeed  Is 
very  responsive.  In  fact,  because  of  an  approximate  2-second  update  rate  on 
the  INS  groundspeed  reference,  the  DME-derived  groundspeed  actually  leads  the 
INS  groundspeed  output  on  rapid  transitions. 

A similar  acceleration  complementation  scheme  was  also  applied  to  the  range 
rate  output  of  the  King  DME-7000  interrogator.  It  should  be  remembered,  how- 
ever, that  early  laboratory  and  flight  test  data  showed  that  the  range  rate 
outputs  were  very  noisy.  This  Introduces  a contradictory  situation.  In  that 
the  output  must  be  filtered  to  obtain  usable  Information,  but  a filtering 
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scheme  such  as  a low-pass  filter  introduces  unacceptable  lags  in  the  ground- 
speed  output.  Acceleration  complementation  is  then  needed  to  reduce  the  ground- 
speed  lags.  Figure  24  Illustrates  the  complementation  scheme  eventually  used 
for  the  King  KDM-7000  Interrogator. 

Figure  25  Illustrates  the  digitized  raw  range  rate  output  of  the  King  KDM-7000 
plotted  with  INS  groundspeed.  The  extremely  noisy  character  of  the  range 
rate  signal  can  be  seen. 

Figures  26,  27,  and  28  illustrate  the  accelerometer-complemented  ground jpeed 
plotted  with  INS  groundspeed  for  stable,  slowly  varying,  and  rapidly  varying 
groundspeeds,  respectively. 

Some  discontinuities  can  be  seen  in  complemented  output  in  figures  26,  27,  and 
28  (the  discontinuities  are  circled  in  the  figures).  These  are  caused  by 
Instantaneous  values  of  velocity  which  are  far  outside  the  expected  range. 

The  reason  for  these  outliers  is  unknown,  but  by  applying  a range  limiter  to 
the  raw  DME  range  rate  data  (figure  29),  some  Improvement  in  the  output  can 
be  obtained.  Figures  30,  31,  and  32  Illustrate  the  results  of  accelerometer 
complemented  range  rate  with  a range  limiter  on  the  raw  range  rate.  The 
limiter  restricted  the  raw  range  rate  input  to  the  filter  algorithm  to  between 
125  and  325  ft/s.  Statistical  summaries  for  the  Collins  and  the  King 
accelerometer-complemented  range  rate  data  are  contained  in  tables  5 and  6, 
respectively.  The  statistics  are  computed  starting  50  seconds  after  the 
actual  start  of  the  run  to  allow  the  high  pass  to  settle.  As  can  be  seen 
from  table  6,  the  range  rate  limiter  does  Improve  the  statistical  results  of 
the  King  DME  runs. 

TABLE  5.  STATISTICAL  ERROR  SUMMARY  OF  RESULTS  FOR  ACCELEROMETER 


COMPLEMENTATION  OF  COLLINS  INTERROGATOR 

STABLE  GROUNDSPEED 

Number  of 

Mean  Error 

Standard 

Deviation 

Samples 

(ft/s)  (knots) 

(ft/s) 

(knots) 

1,547 

2.0  1.2 

4.9 

2.9 

SLOWLY  VARYING  GROUNDSPEED 

Number  of 

Mean  Error 

Standard 

Deviation 

Samples 

(ft/s)  (knots) 

(ft/s) 

(knots) 

1,500 

8.2  4.8 

6.4 

3.8 

RAPIDLY  VARYING  GROUNDSPEED 

Number  of 

Mean  Error 

Standard 

Deviation 

Samples 

^ft/s)  (knots) 

(ft/s) 

(knots) 

1,499  8.3  4.9  6.0  3.5 
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TABLE  6. 


STATISTICAL  ERROR  SUMMARY  OF  RESULTS  FOR  ACCELEROMETER 
COMPLEMENTATION  OF  KING  INTERROGATOR 


STABLE  GROUNDSPEED 


Number  of 
Samples 

Mean 

(ft/s) 

Error 

(knots) 

Standard 

Deviation 

(knots) 

Accelerometer 

complemented 

1,479 

-1.4 

-0.8 

7.5 

4.4 

Range  limited 
with  acceler- 
ometer com- 
plementation 

1,479 

0.0 

0.0 

4.3 

2.5 

SLOWLY  VARYING 

GROUNDSPEED 

Number  of 
Samples 

Mean 

(ft/s) 

Error 

(knots) 

Standard 

Deviation 

(knots) 

Accelerometer 

complemented 

1,222 

-1.7 

-1.0 

6.7 

3.9 

Range  limited 
with  acceler- 
ometer com- 
plementation 

1,222 

-4.0 

-2.4 

5.6 

3.3 

RAPIDLY  VARYING  GROUNDSPEED 

Number  of 
Samples 

Mean 

(ft/s) 

Error 

(knots) 

Standard 

(ft/s) 

Deviation 

(knots) 

Accelerometer 

complemented 

1,202 

1.4 

0.8 

7.1 

4.2 

Range  limited 
with  acceler- 
ometer com- 
plementation 

1,202 

8.0 

4.7 

6.3 

3.7 

KALMAN  FILTER  WITH  VELOCITY  OBSERVATIONS.  The  Kalman  filter  provided  a method 
capable  of  extracting  an  optimum  velocity  estimate  (in  a mean-square  sense) 
from  the  noisy  observations  of  the  IME.  Figure  33  shows  a block  diagram  of 
the  Implementation  of  the  discrete  time  Kalman  filter.  The  block  labeled  K(k) 
represents  the  updating  of  the  Kalman  gains  based  on  the  previous  Iteration 
as  well  as  the  updating  of  the  covariance  matrix  based  on  the  present  data. 

The  covariance  matrix  represents  the  mean-square  error  of  the  estimate.  There- 
fore, the  Kalman  filter  Is  a time-varying  optimum  statistical  estimator  which 
depends  on  the  input  and  output  to  alter  Its  filtering  process. 
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Implementation  of  the  Kalman  filter  required  a model  of  the  measurement  process 
and  a model  for  the  dynamics  of  the  process  under  measurement.  The  models 
were  simple  and  Incorporated  statistics  of  the  noisy  DME  range  rate  as  well  as 
some  very  simplified  aircraft  dynamics  and  maneuver  statistics.  A description 
of  the  development  Is  contained  In  the  appendix. 

Figures  34  and  35  are  plots  of  the  output  of  the  Kalman  filter  with  a velocity 
Input  for  the  slowly  varying  groundspeed  condition.  Also  plotted  on  these 
figures  Is  INS  groundspeed.  Figure  34  represents  the  results  obtained  when 
using  the  Collins  Interrogator  for  this  groundspeed  condition,  while  figure  35 
represents  the  results  obtained  with  the  King  Interrogator.  A velocity  limiter 
was  used  to  prefllter  the  data  prior  to  the  Kalman  filtering  process.  The 
velocity  limiter  range  was  from  125  ft/s  to  325  ft/s  (75  knots  to  195  knots). 

The  results  of  the  filtering  process  for  either  Interrogator  are  not  satisfactory 
because  of  the  lack  of  responsiveness  In  the  case  of  the  Collins  interrogator, 
and  the  noisy  output  in  the  case  of  the  King  Interrogator. 

KALMAN  FILTER  WITH  VELOCITY  AND  ACCELERATION  OBSERVATIONS.  The  Kalman  filter 
produces  an  optimum  (mean-square)  estimate  of  the  state  of  a system.  The 
filter  depends  on  a measurement  of  the  system's  state.  Its  own  model  of  the 
dynamics  of  the  system,  and  a description  of  the  noise  processes  Involved  to 
provide  such  an  estimate. 

Performance  of  the  filter  is  affected  by  the  accuracy  of  the  system  model,  the 
accuracy  of  the  noise  model,  and  the  measurement  made  on  the  actual  system. 
Generally,  a more  accurate  system  model  will  call  for  more  states  and  the 
complexity  (order)  of  the  computations  will  increase.  In  the  previous  case, 
velocity  was  estimated  based  on  noisy  velocity  samples  and  a system  model 
(double  Integrator)  whose  state  vector  contains  two  entries,  velocity  and 
acceleration.  By  including  acceleration  in  the  measurement,  the  performance 
may  be  improved  with  a moderate  Increase  in  the  computations  required.  The 
acceleration  employed  for  this  case  was  pitch-compensated  longitudinal 
acceleration. 

To  eliminate  the  biases  due  to  the  acceleration  term  that  were  experienced  in 
the  accelerometer  complementation  algorithms,  the  acceleration  term  was  high- 
passed  to  remove  any  bias  errors  prior  to  using  It  In  the  Kalman  filter.  A 
time-varying  high-pass  digital  filter  similar  to  the  one  developed  for  the 
accelerometer  complementation  scheme  was  used  for  this  purpose.  To  compen- 
sate for  attenuation  of  the  lower  frequency  components,  the  filtered  accelera- 
tion was  multiplied  by  a gain  factor  greater  than  unity.  The  original  filter 
equations  (appenc.ix)  were  revised  to  accommodate  the  newly  Included  acceleration 
observation.  This  approach  was  utilized  for  both  the  Collins  860E-3  and  the 
KDM-7000. 

In  the  case  of  the  KDM-7000,  which  provides  no  range  rate  filtering,  the 
dynamic  model  Is  a suitable  one.  However,  the  Collins  860E-3  provides  a 
30-second  low-pass  range  rate  as  the  velocity  observation.  This  would  seem- 
ingly alter  the  signal  dynamics  and  require  a reformulation  of  the  filter. 


However,  If  the  effect  of  the  30-8econd  low-pass  filter  is  modeled  as  an 
additive  noise  source,  only  the  statistical  noise  descriptors  will  require 
modification.  This  was  done,  and  the  same  filter  equations  were  utilized  for 
both  the  Collins  860E-3  and  the  King  KDM-7000. 

As  done  previously,  the  range  rate  input  observations  to  the  filter  from  the 
King  mE  were  range  limited  to  between  125  and  325  ft/s.  This  limiter  was 
also  used  on  the  Collins  IME  range  rate  observations,  but  did  not  offer  any 
improvement  In  the  performance  and  therefore  was  not  needed. 

The  filter  was  Implemented  In  Fortran  on  a PDF  11/15.  Raw  data  tapes  recorded 
on  previous  test  flights  were  filtered  and  plotted  and  statistics  were  computed 
using  INS  groundspeed  as  the  reference. 

Figures  36  through  41  are  plots  of  the  results  using  both  velocity  and  accelera- 
tion as  Inputs  to  the  filters.  Figures  36  through  38  are  the  results  when  using 
the  Collins  DME  In  the  three  different  groundspeed  conditions,  and  figures  39 
through  41  are  the  results  when  using  the  King  DME.  As  can  be  seen,  the  addi- 
tion of  the  acceleration  observations  to  the  Kalman  filter  greatly  improve  the 
tracking  accuracy  and  responses  of  the  measurement.  Statistical  summaries  of 
the  Kalman  filter  results  for  the  Collins  and  the  King  interrogator  are  con- 
tained In  tables  7 and  8. 


TABI.R  7.  STATISTICAL  EIIAOR  SUMMARY  OF  RESULTS  FOR  KALMAM  FILTERING  ON  COLLINS 
INTERROGATOR 

STABLE  GROUNDSFEED 


Nueber  of 

Mean 

Error 

Standard 

Deviation 

Saaplea 

(ft/s) 

0.4 

(knota) 

(ft/s) 

(knots'/ 

Velocity 

1,547 

0.2 

6.0 

3.5 

Velocity  and 
acceleration 

1,347 

0.2 

0.1 

5.9 

3.3 

SLOULY  VARYING  GROUNDSFEED 

NuBBber  of 

Mean 

Error 

Standard 

Devlaclon 

Saoiples 

(ft/s) 

(knots) 

(ft/s) 

(knots) 

Velocity 

1,500 

5.0 

3.4 

8.5 

5.0 

Velocity  and 
acceleration 

1,500 

-0.9 

-0.5 

7.0 

4.1 

RAFIDLY  VARYING  GROUNDSFEED 

Niaber  of 

Mean 

Error 

Standard 

Deviation 

Saaplea 

Sft/3i 

(knots) 

(ft/s) 

(knots) 

Velocity 

1,499 

2.8 

1.7 

12.7 

7.5 

Velocity  and 
acceleration 

1,499 

0.6 

0.4 

6.1 

3.6 

TABLE  8,  STATISTICAL  ERROR  SUMMARY  OF  RESULTS  FOR  KALMAN  FILTERING  ON  KING 
INTERROGATOR 


STABLE  GROUNDSFEED 


Niaber  of 
Samples 

Mean 

Ift/sl 

Error 

(knots) 

Standard 

SiLhl 

Deviation 

(knots) 

Velocity 

1,479 

2.3 

1.4 

13.6 

8.0 

Velocity  and 
acceleration 

1,479 

-2.6 

-1.5 

2.8 

1.6 

Ntaiber  of 
Saaples 

SLOWLY  VARYING  GROUNDSFEED 

Mean  Error  Standard 

(ft/s)  (knots)  (ft/s) 

Deviation 

(knots) 

Velocity 

1,222 

-1.4 

-0.8 

10.4 

6.1 

Velocity  and 
acceleration 

1,222 

6.5 

3.8 

4.5 

2.7 

Nuaber  of 
Saaplea 

RAPIDLY  varying  GROUNDSFEED 

Mean  Error  Standard 

(ft/a)  (knots)  (ft/a) 

Devlaclon 

(knots) 

Velocity 

1,202 

-5.4 

-3.2 

14.6 

8.6 

Velocity  and 
acceleration 

1,202 

-5.9 

-3.5 

6.1 

3.6 
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CONCLUSION 

Based  on  the  tests  conducted,  it  is  concluded  that  responsive  and  accurate 
groundspeed  can  be  obtained  from  an  ARINC  characteristic  568  DM£.  By  utilizing 
suitable  Interface  circuitry  to  make  use  of  the  range  rate  pulse  output  and 
suitable  digital  filtering,  groundspeed  outputs  with  a standard  deviation 
of  about  3 knots  when  compared  to  INS  groundspeed  were  typically  obtained. 
Response  of  the  digital  filter  was  such  that  there  was  no  time  lag  between 
the  groundspeed  output  of  the  filter  and  the  groundspeed  output  of  the  INS. 

The  techniques  utilized  lend  themselves  to  microprocessor  technology  for 
hardware  implementation  and  require  no  modification  to  either  the  airborne  or 
ground  DKE  equipment. 


FIGURE  1.  DME  LABORATORY  TEST  SETUP 


FIGURE  2.  COLLINS  860E-3  INTERROGATOR  RANGE  RATE  RESPONSE  FOR  VELOCITY 
CHANGE  OF  -5  KNOTS 
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VElX>CITy-KNOTS 


FIGURE  5.  COLLINS  860E-3  INTERROGATOR  RANGE  RATE  RESPONSE  FOR  A STEP 
VELOCITY  CHANGE  OF  -15  KNOTS 


FIGURE  6.  KING  KDM-7000  INTERROGATOR  RANGE  RATE  RESPONSE  FOR  A CONSTANT 
VELOCITY  OF  120  KNOTS 


KOM.7000  RANGE  RATE  DATA 


SIMULATED  AIRCRAFT  VELOCITY 


10  POINT  AVERAGE  72  Hz  P.  R,  F. 


RUN  10  TYPICAL  OF  4 RUNS 


40  60  80  loo 

TIME -SECONDS 


FIGURE  7. 


KING  KDM-7000  INTERROGATOR  RANGE  RATE  RESPONSE  FOR  A VELOCITY 
CHANGE  OF  -15  KNOTS 


PHOTOTHEODOLITE 


2 3 

TIME -MINUTES 


FIGURE  8.  COLLINS  860E-3  INTERROGATOR  RANGE  RATE  RESPONSE  FOR  AN 
AIRBORNE  ACCELERATION  RUN 


VELOCITY-KNOTS 


FIGURE 


160 


140 


120 


2 3 

TIME-MINUTES 


5 

77-28-9 


KING  KDM-7000  INTERROGATOR  RANGE  RATE  RESPONSE  FOR  AN  AIRBORNE 
DECELERATION  RUN 


FIGURE  10.  GENERAL  PUTPOSE  DIGITAL  COMPUTER  INSTALLATION  IN  TEST  BED 
AIRCRAFT  N-42,  A CV880 


FIGURE  11.  BLOCK  DIAGRAM  OF  DME  DATA  INTERFACE  TO  GENERAL  PURPOSE  COMPUTER 


G’  « Gideal 


G = 30  SECOND  LAGGED  DME  RANGE  RATE 
G'=  COMPENSATED  DME  RANGE  RATE 
Gideal  = ideal  (TRUE)  RANGE  RATE 

77-28-12 


FIGURE  12.  BLOCK  DIAGRAM  OF  LEAD/LAG  COMPENSATION 
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DME 


TIME  (S)  77-28-13 


FIGURE  13.  PLOT  OF  RAW  DME  RANGE  RATE  FROM  COLLINS  860E-3  AND  INS 
GROUNDSPEED  FOR  A TEST  APPROACH 


FIGURE  14.  PLOT  OF  OUTPUT  OF  LEAD/LAG  FILTER  AND  INS  GROUNDSPEED  FOR  A 
TEST  APPROACH 


2 


RAW  RANGE  RATE 
(fps) 


LEAD/ LAG.  OUTPUT 
(fps) 


21S.  7521 

215.  7521 

215.  7521 

215.  7521 

215.  7521 

215.  7522 

2L£L-a22i 

. 250.  3577 

216.  9222 

247.  1732 

216.  9223 

244.  2321 

216.  2136 

220.  7263 

216.  2136 

220.  2366 

_^216.  2136 

219.  3073 

215.  3730 

194  6976 

215.  ;:<730 

136.  6667 

^ _ 215.  3730 

138.  4483 

"*'214.  4664 

173.  2530 

214.  4664 

177.  1780 

214.  4664 

180.  7232 

"•“aiS.  3390 

±SS.  3455 

213.  3330 

172.  6876 

212.  7353 

141.  0361 

212.  7358 

147.  8643 

212.  7358 

154.  0432 

212.  4391 

150.  8597 

212.  4331 

156.  7241 

212.  4331 

162.  0233 

212.  4331 

166.  8304 

212.  4331 

171.  1737 

212.  4391 

175.  1034 

212.  5215 

181.  0354 

212.  5215 

184.  0879 

212.  5215 

136.  7355 

212.  4331 

186.  8037 

212.  4331 

183.  2433 

212  4331 

131.  4575 

212.  4331 

133.  4554 

212.  4331 

135,  2630 

_^212.  4331 

136.  8985 

213.  6423 

233.  3587 

213.  6423 

232.  0236 

-►=  RAW  RANGE  RATE  CHANGED 
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FIGURE  15.  PRINTOUT  OF  INPUT  TO  AND  OUTPUT  FROM  LEAD/LAG  FILTER 
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0 30  bo  90  120  ISO  ISO  210  240 

TIMS  (S)  77-26-16 

FIGURE  16.  PLOT  OF  OUTPUT  OF  LEAD/LAG  FILTER  AND  INS  GROUNDSPEED  WITH  A 
5-SECOND  LOW-PASS  FILTER  ON  INPUT  TO  LEAD/LAG  FILTER 


DME  RANGE 
RATE  FROM 
COLLINS  860E-3 


PITCH  COMPENSATED 


LONGITUDINAL 

ACCELERATION 


30 

30S+1 

ACCELEROMETER 
COMPLEMENTED 
GROUND  SPEED 
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FIGURE  17.  BLOCK  DIAGRAM  OF  ACCELEROMETER  COMPLEMENTATION  FOR 
COLLINS  860E-3  INTERROGATOR 
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FIGURE  18.  PLOT  OF  COLLINS  860E-3  ACELER(»1ETER-C0MPLEMENTED  RANGE  RATE  FOR 
A STABLE  GROUNDSPEED  TEST  APPRAOCH 


FIGURE  19.  PLOT  OF  COLLINS  860E-3  ACCELER0METER-C(»1PLEMENTED  RANGE  RATE 
FOR  A SLOWLY  VARYING  GROUNDSPEED  TEST  APPROACH 
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FIGURE  20.  PLOT  OF  COLLINS  860E-3  ACCELEROMETER-COMPLEMENTED  RANGE  RATE 
FOR  A RAPIDLY  VARYING  GROUNDSPEED  TEST  APPROACH 


TIME  <S)  77-28-21 

FIGURE  21.  PLOT  OF  COLLINS  860E-3  TIME-VARYING  ACCELEROMETER-COMPLEMENTED 
RANGE  RATE  FOR  A STABLE  GROUNDSPEED  TEST  APPROACH 


TIME  (S) 


77-28-22 


FIGURE  22.  PLOT  OF  COLLINS  860E-3  TIME-VARYING  ACCELEROMETER-COMPLEMENTED 
RANGE  RATE  FOR  A SLOWLY  VARYING  GROUNDSPEED  TEST  APPROACH 


TIME  (SI  77-28-2] 

FIGURE  23.  PLOT  OF  COLLINS  860E-3  TIME-VARYING  ACCELER(M1ETER-C0MPLEMENTED 
RANGE  RATE  FOR  A RAPIDLY  VARYING  GROUNDSPEED  TEST  APPROACH 


FIGURE  24.  BLOCK  DIAGRAM  OF  ACCELERCMETER  COMPLEMENTATION  FOR  KING  KDM-7000 


FIGURE  25.  PLOT  OF  RAW  DME  RANGE  RATE  FROM  KING  KIM-7000  AND  INS 
GROUNDSPEED  FOR  A TEST  APPROACH 
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FIGURE  28. 
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FIGURE  29. 
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PLOT  OF  KING  KDM-7000  TIME-VARYING  ACCELEROMETER-COMPLEMENTED 
RANGE  RATE  FOR  A RAPIDLY  VARYING  GROUNDSPEED  TEST  APPROACH 


COMPLEMENTED 
GROUND  SPEED 

77-28-29 

BLOCK  DIAGRAM  OF  RANGE  RATE  LIMITING  AND  ACCELER(»1ETER 
COMPLEMENTATION  FOR  KING  KDM-7000 
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FIGURE  30.  PLOT  OF  KING  KDM-7000  NONLINEAR  TIME-VARYING  ACCELEROMETER- 

COMPLEMENTED  RANGE  RATE  FOR  A STABLE  GROUNDSPEED  TEST  APPROACH 


FIGURE  31.  PLOT  OF  KING  KDM-7000  NONLINEAR  TIME-VARYING  ACCELEROIETER- 
COMPLEMENTED  RANGE  RATE  FOR  A SLOWLY  VARYING  GROUNDSPEED 
TEST  APPROACH 


42»t 


TIME  (S)  7T.2B-12 


FIGURE  32.  PLOT  OF  KING  KDM-7000  NONLINEAR  TIME-VARYING  ACCELEROMETER- 
COMPLEMENTED  RANGE  RATE  FOR  A RAPIDLY  VARYING  GROUNDSPEED 
TEST  APPROACH 
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FIGURE  33.  BLOCK  DIAGRAM  OF  IMPLEMENTATION  OF  KALMAN  FILTER 
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FIGURE  34.  PLOT  OF  COLLINS  860E-3  RANGE  RATE  WITH  KALMAN  FILTERING 

(VELOCITY  OBSERVATIONS)  AND  INS  GROUNDSPEED  FOR  A TEST  APPROACH 


TIME  SI  TJ-2H5 

FIGURE  35.  PLOT  OF  KING  KI»i-7000  RANGE  RATE  WITH  KALMAN  FILTERING  (VELOCITY 
OBSERVATIONS)  AND  INS  GROUNDSPEED  FOR  A TEST  APPROACH 


TIME  <S) 


77>2»>36 


FIGURE  36.  PLOT  OF  COLLINS  860E-3  DUAL-INPUT  KALMAN-FILTERED  RANGE  RATE  FOR 
A STABLE  GROUNDSPEED  TEST  APPROACH 


FIGURE  37.  PLOT  OF  COLLINS  860E-3  DUAL-INPUT  KAIMAN-FILTERED  RANGE  RATE  FOR 
A SLOWLY  VARYING  GROUNDSPEED  TEST  APPROACH 
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FIGURE  38. 


FIGURE  39. 


PLOT  OF  COLLINS  860E-3  DUAL-INPUT  KALMAN-FILTERED  RANGE  RATE  FOR 


A STABLE  GROUNDSPEED  TEST  APPROACH 
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FIGURE  40.  PLOT  OF  KING  KDH-7000  DUAL-INPUT  KALMAN-FILTERED  RANGE  RATE 
FOR  A SLOWLY  VARYING  GROUNDSPEED  TEST  APPROACH 


TIME  (S)  rr-n-*i 

FIGURE  41.  PLOT  OF  KING  KDM-7000  DUAL-INPUT  KALMAN-FILTERED  RANGE  RATE  FOR 
A RAPIDLY  VARYING  GROUNDSPEED  TEST  APPROACH 


38 


APPENDIX  A 

STATISTICAL  ESTIMATOR  DESIGN  FOR  DME-DERIVED  GROUNDSPEED 
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A-3  Acceleration  Rate  Probability  Density  Function  A-2 
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STATISTICAL  ESTIMATOR  DESIGN  FOR  DME-DERIVED  GROUNDSPEED 


KALMAN  FILTER  TECHNIQUE. 

The  range  rate  output  of  the  King  DME  Is  an  extremely  noisy  signal.  It  Is 
possible,  however,  to  estimate  the  state  (velocity)  of  the  dynamic  system 
(aircraft)  from  observations  contaminated  by  noise.  The  problem  may  be 
approached  by  utilizing  theory  and  techniques  for  designing  statistical  state 
estimators  (Kalman  filter). 

The  Kalman  filter  provided  a method  capable  of  extracting  an  optimum  velocity 
estimate  (in  a mean-square  sense)  from  the  noisy  observations  of  the  DME. 

Figure  A -1  shows  a block  diagram  of  the  Implementation  of  the  discrete  time 
Kalman  filter.  The  block  labeled  K(k)  represents  the  updating  of  the  error 
covariance  matrix  based  on  the  present  data  (the  covariance  matrix  Is  a 
statistical  matrix  which  represents  the  difference  between  the  filtered  esti- 
mate and  the  actual  state  of  the  system).  Therefore,  the  Kalman  filter  Is  a 
time-varying,  optimum  statistical  estimator  which  depends  on  the  Input  and 
output  to  alter  its  filtering  process. 

The  first  step  was  to  assume  a model  for  the  dynamics  of  the  signal  process 
(aircraft  and  DME).  The  aircraft  was  modeled  as  a double  Integrator  with 
acceleration  rate  (c)  as  the  Input  and  the  velocity  (range  rate,  y (t))  as  the 
output  (figure  A-2).  The  acceleration  rate  was  assumed  to  be  a random  variable. 
These  follow  from  the  underlying  assumption  that  the  aircraft  Is  stabilized 
in  an  approach  configuration.  The  probability  density  function  F(c)  of  the 
acceleration  rate  (c)  which  was  assumed  is  shown  in  figure  A-3.  In  this 
model,  PI  represents  a discrete  probability  that  maximum  acceleration  rate 
(+A)  will  be  demanded.  P2  represents  the  discrete  probability  that  the 
acceleration  rate  is  not  changing.  The  height  of  the  uniform  distribution  Is! 

a - (1-2Pj^-P2)/2A 

The  variance  of  the  acceleration  rate  is: 

®c  - A^  (1+4P  -P,) 

3 ^ 

The  DME  was  assumed  to  present  the  velocity  after  adding  some  noise  (n)  to  It. 
This  measurement  noise  was  assumed  to  be  stationary,  additive,  of  zero  mean, 
and  white. 

A discrete  time  model  which  approximates  the  assumed  dynamic  model  is  shown 
In  figure  A-4.  The  discrete  system  is  described  by  the  following  set  of 
equations: 

S(k)  - ♦S(k-l)-*w(k-l) 

Y(k)  - HS(k)+n(k) 


A-1 


77- 28- A- 1 


FIGURE  A-1.  BLOCK  DIAGRAM  OF  KALMAN  FILTER  IMPLEMENTATION 


FIGURE  A-2.  BLOCK  DIAGRAM  OF  AIRCRAFT  MODEL 

F(c) 

Pi  PZ  Pi 


-A  O +A  C 


77-28-A-3 

FIGURE  A-3.  ACCELERATION  RATE  PROBABILITY  DENSITY  FUNCTION 


77-28-A-4 


FIGURE  A-4.  DISCRETE  TIME  MODEL  OF  ASSUMED  AIRCRAFT  SYSTEM 

A-2 


where  ^ is  the  state  vector,  W is  the  input  noise  vector,  Y is  the  output 
vector,  n is  the  output  noise  vector,  4>  is  the  state-transition  matrix,  and 
H is  the  measurement  matrix. 


For  the  particular  model,  the  values  are  given  below: 


■f;  i] " 


Velocity 

Acceleration 


H-[l  0]  w 


■PI 


For  the  assumed  discrete  system,  the  general  Kalman  algorithm  is  defined  by 
the  following  set  of  matrix  equations: 


K(m)  - V(m-l)  rT  jHV(m-l)HT  + R(m)  j 
l(m)  - £(m-l)  + K(m)  |Y(m)-H  *^(10-1)  j 

V(m)  - V(m-1)-K(m)  HV(m-l) 


V(m) 

R(m) 


♦ V(m)$  +U(m) 

I n(m)n(m)^i. 


* x *00  *0  0* 

U(m)  » E|w(m)  w(m)  | “ 0 e|w^|  “ 0 ^ 


where: 

K = Kalman  gain  matrix 

V = Predicted  covariance  matrix 

V = Estimate  covariance  matrix 

U = Input  noise  covariance  matrix 
R * Output  noise  covariance  matrix 

V ■■  Observation  matrix 

A 

S ■ Optimum  estimate  vector 
E ■ Expectation  operator 


All  that  remains  is  to  define  the  initial  covariance  matrices  and  the  initial 
state  vector.  The  output  covariance  matrix  R was  derived  empirically  from 
a data  tape  by  comparing  raw  DME  range  rate  to  INS  groundspeed  and  calculating 
the  variance.  This  was  estimated  to  be  10^  ft^/s^.  The  input  noise  to  the 
discrete  system  is  a random  acceleration  described  by: 

ow  ■ T Og-+-  ov^  ■ ^3^  (1+4Pj^-P2) 


A-3 


I 


i 


i 


Therefore,  If: 

A - 5 ft/s^ 

T - 0.1  s 
Pi-  0.01 
P2  - 0.3 

o 0.0625  ft^/s^ 

w 

The  Initial  covariance  matrix  V^0)  Is  defined  by; 

V(0)  - E ! [s(0)  - S(0)]  [s(0)  - S(0)] 


V(0)« 

■0l2 

0 ^2/^ 

2 1 
ai  /T 

1 

1 

0 

10^ 

> 

Ll05 

2x10^+0.0625 

The  state  vector  ^(0)  was  Initialised  to  the  first  range  rate  value  for 
velocity,  while  the  Initial  acceleration  was  assumed  to  be  zero.  This  Is  not 
an  exact  Initialization,  but  It  provides  a satisfactory  starting  point. 

Since  the  Collins  860E-3  provides  a 30-8econd  low-pass  filtered  range  rate 
output,  the  system  model  for  this  DME  will  be  slightly  different  from  that  of 
the  KDM-7000.  The  dynamic  signal  model  is  shown  in  figure  A-5.  In  this  case, 
the  aircraft  Is  assumed  to  be  an  Integrator  with  a random  acceleration  as  the 
input.  The  model  also  includes  the  filtering  Imposed  by  the  DME.  From  this 
we  see  that  we  are  going  to  estimate  velocity  of  the  aircraft  (S2)  based  on 
observations  of  filtered  range  rate  (Si)  which  also  contains  a noise  term  (n) . 
The  new  state  vector  ^ becomes: 


S 


= Filtered  range  rate 
S2  - Aircraft  velocity 


n 


SIGNAL  DYNAMICS  MODEL  FOR  TOTAL  SYSTEM  (FOR  COLLINS  INTERROGATOR) 


FIGURE  A-5. 


The  state  transition  matrix  0 for  this  system  for  sample  period  T 
^ _fe(-T/30)  i-e(-T/30)'’ 


0.1  s Is: 


0.9967  3.328x10 


0 1 


0 1 


The  noise  components  were  assumed  to  be  stationary,  additive,  white,  and  of 
zero  mean.  For  the  random  input  to  the  discrete  system,  the  assumption  was 
made  that  10  ft/s  was  an  approximate  S-slgma  value.  From  this  assumption, 
the  variance  of  the  input  to  the  discrete  system  can  be  calculated  as  follows 


3o^  » 10  ft/s 


o„  = 


_ 10 


“J  ft/s 


2 = 100  2.2 


'w 


ft  /s  , or  « 


10  ft^/s^ 


A 1-slgma  value  of  20  ft/s  was  experimentally  determined  by  trial  and  error  to 
be  a good  all-around  estimate  of  the  output  noise  statistics  (on). 


The  initial  covariance  matrix  in  this  instance  becomes: 


With: 


V(0) 


2 

1 


T = 0.1  s 


oj^*  20  ft/s 
aw=  10 


1-e 


201^  . _ 7 

(l-e“T/30  ) 2 


1 


Then: 


V(0) 


Taoo.oo 

“|l20,200. 


11 


120,200.11 

74,240,341.19 


A-5 


This  altered  system  model  In  no  way  changes  the  mechanization  of  the  Kalman 
filtering  algorithm.  The  filter  equations  presented  during  the  discussion  of 
the  KWi-7000  are  directly  applicable  to  the  Collins  860E-3  once  the  appropriate 
substitutions  have  been  made. 

VELOCITY  AND  ACCELERATION  OBSERVATIONS. 

By  Including  observations  of  the  longitudinal  acceleration.  It  was  possible  to 
greatly  Improve  the  performance  of  the  Kalman  filter.  This  entails  modifying 
the  discrete  system  to  account  for  the  extra  observation.  The  discrete  system 
block  diagram  and  the  filter  equations  remain  the  same,  although  certain  matrix 
and  vector  quantities  must  be  redefined.  The  new  assignments  are  made  below: 


Velocity  neasurement  noise 


*^2  **  Acceleration  measurement  noise 


Wj^  = Velocity  maneuver  noise 
w„  = Acceleration  maneuver  noise 


These  changes  require  that  the  Input  and  output  noise  covariance  matrices  (U 
and  R,  respectively)  be  reevaluated. 

T 

U(m)  = E|w(m)  w(m)  [ = 0 

The  U matrix  was  arbitrarily  set  to  zero.  This  Imposes  the  condition  that  the 
system  Is  not  driven  by  any  external  noise  disturbances. 

R(m)  = E{  n(m)  n(m)'*’} 


R(m) 


r 2 

01 


Where: 


ac‘ 


^2  J 


= Velocity  measurement  noise 
02^  = Acceleration  measurement  noise 
Oq^  » Cross-correlation  measurement  noise 


The  initial  covariance  matrix  V (o)  was  also  modified  in  accordance  with  the 
new  design. 

V(0)  = E^^S(O)  - S(0)J  ^S(O)  - S(0)J^  J 
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The  best  assumption  which  could  be  made  here  Is  Chat  the  best  a priori 
estimate  S(0)  will  be  the  initial  measurement. 

S(0)  - HS(0)  + n(0) 


Since  H 


1 ol  A 

[o  .]. 


S(0)  - £(0)  + n(0) 


and  therefore: 


V(0)  = E|-n(0)  [-n(0/  {■K  n(0)  n(0f  I 
E|n(0)  n(0)^|«  E in(m)n(m)'^| 


Hence  the  initial  covariance  matrix  was  set  equal  to  the  output  noise 
covariance  matrix.  V(0)=R(m) 


From  this  point  on,  the  Initialization  and  implementation  of  Che  Kalman  filter 
for  the  KDM-7000  is  straightforward.  The  velocity  measurement  covariance 

is  the  same  as  before,  10^  (ft/s)^.  The  correlation  terms  of  R(M)  were 
arbitrarily  set  equal  to  zero.  The  acceleration  measurement  covariance  02^ 
was  experimentally  determined  (by  trial  and  error)  to  be  10”^(ft/8)2.  This 
was  Che  value  which  provided  the  best  filter  performance. 


Hence : 

0 

0 

V(0)  = R(m)  =1^  0 10"^  J 

The  initial  velocity  was  set  equal  to  the  first  range  rate  measurement 
Yi(0),  and  the  initial  acceleration  was  arbitrarily  set  equal  to  zero. 


S(0) 


[Tl 


The  Collins  860E-3  may  be  handled  in  an  identical  manner  if  the  effect  of 
the  30-second  low-pass  filter  is  treated  as  measurement  noise.  The  imple- 
mentation and  assumptions  are  Identical  to  those  made  in  the  ceiae  of  the 
KDM-7000.  Only  the  values  of  gjjd  0'2^  are  different.  The  velocity  mea- 
surement covariance  used  for  the  Collins  860E-3  was  400  ft/s^.  The 

acceleration  covariance  which  provided  the  best  performance  in  this  case  was 
0.001  ft/s2.  1^00  0 *1 

V(0)  - K(m)  - 0 .001 


Due  to  the  extremely  noisy  nature  of  the  KDM-7000  range  rate  output  (figure  25), 
it  was  necessary  to  place  a limiter  on  the  input  to  the  Kalman  filter.  This 
limited  the  velocity  to  a range  of  125  to  325  ft/s.  An  identical  limiter  was 
utilized  with  the  Collins  860E-3;  however,  it  was  not  necessary  to  do  so.  The 
limiter  was  used  for  all  of  the  Kalman  filter  results  presented  in  the  report. 
The  limiter  eliminated  gross  outliers  and  reduced  the  noise  on  the  output  of 
the  Kalman  filter. 
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When  the  observation  of  acceleration  was  Included,  bias  errors  were  encountered 
which  were  not  reduced  by  the  Kalman  filter.  Since  the  Kalman  filter  Is  based 
on  optimizing  mean  square  error,  this  Is  not  overly  surprising.  The  pitch- 
compensated  longitudinal  acceleration  term  was  high-pass  filtered  to  wash  out 
these  biases.  The  high-pass  filter  was  actually  time-varying  In  nature.  This 
was  accomplished  by  Incrementing  the  filter  time  constant  from  an  Initial 
value  to  some  final  value.  This  technique  hastened  the  washout  and  still  pro- 
vided adequate  bandwidth  once  the  filter  was  In  the  steady-state  condition. 

The  filter  for  the  KDM-7000  was  Initialized  to  a 1-second  time  constant  and 

allowed  to  Increment  up  to  a bO-second  time  constant.  In  the  case  of  the  r 

Collins  860E-3,  we  found  that  we  had  to  Initialize  at  a 30-second  time  constant 

and  Increment  up  to  a 60-second  time  constant.  In  each  case,  the  time  constant 

was  Incremented  at  the  rate  of  0.1  second  per  sample  period.  This  provided  a , 

much  better  covariance  of  the  output  of  the  Kalman  filter.  We  also  found  a 

need  to  premultiply  the  filtered  acceleration  by  a gain  factor  before  entering 

the  Kalman  filter.  The  KDM-7000  required  a gain  of  1.5,  while  the  860E-3 

required  a gain  of  1.8  to  provide  a useful  result. 


